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ALGORITHMS  FOR  COMPUTING  APPARENT  SPEED 
A.  P.  Tkachenko 


In  controlling  moving  objects  of  several  classes,  it  is  expe¬ 
dient  to  use  information  on  the  apparent  speed  of  the  object.  The 
apparent  speed  will  be  called  the  vector  value,  equal  to  the  increase 
in  integral  from  the  vector  of  the  apparent  acceleration  from  the 
beginning  moment  in  time  t*0  to  some  moment  t.  This  same  apparent 
acceleration  Is  the  difference  between  the  acceleration  of  an  object 
relative  to  an  immobile  coordinate  system  and  the  acceleration  of 
gravity  [1],  (Hereafter,  by  speed  or  acceleration  of  an  object  we 
means  the  speed  or  acceleration  of  a  certain  point  of  It,  such  as 
the  center  of  mass).  The  speed  of  an  object  relative  to  an  immobile 
coordinate  system  equals  the  vector  total  of  the  apparent  speed  of 
an  object,  the  vector  of  initial  speed  of  an  object  at  moment  t *0 
and  the  integral  of  acceleration  of  gravity  in  the  area  of  origination 
of  the  object  within  t»0  to  the  current  moment  in  time  t. 

Let  us  connect  the  right  orthogonal  triangle  xyz  with  the  object. 
Its  orientation  relative  to  some  nonrotating  trihedron  £n£  will  be 
characterized  by  a  matrix  of  directrices  of  cosines  L: 


u 

In 

u 

l*n 

This  matrix  satisfies  the  differential  equation 


(1) 


L  =m  —SIL, 


(2) 


1 


where 


0  -to,  I 


<(■>„  to,,  to,  projections  of  angular  speed  of  an  object  on  axis  x,y,z). 

let:  us  indicate  through  117  =  (117*,  H7n,  U7;)  the  vector  of  apparent 

speed  of  an  object  assigned  in  the  coordinate  system  £,n,5,  and 

through  w«(w  ,w  ,w  )  -  the  same  vector  assigned  in  the  coordinate 
xyz 

system  xyz: 

1  07  =  Ltw  ( 4 ) 

(index  T  indicates  transposition). 

In  the  center  of  mass  of  the  object,  let  us  establish  three 

integrators  of  linear  accelerations,  the  sensitivity  axes  of  which 

are -parallel  to  axes  x,y,z.  Signs  b  ,  b  ,  b  of  these  integrators 

xyz 

are  the  essence  of  increase  of  integrals  from  projections  of  the 
apparent  acceleration  of  an  object  on  axis  x,  y,  z  for  some  period 
of  discretion  (step)  h: 

bx  *■  J  (hlM-i  +  +  ^x;U7J  dt  *  f  (wt  +  ayu>t  —  u>twy)  dt  (xyz).  (  5  ) 

For  shortening  one  written  form,  we  use  here  a  symbol  of  cyclical 
transposition  of  indexes.  Introducing  the  symbolic  vector  b=(bx,by, 
b,),  we  present  the  equations  in  (5)  in  a  matrix  form: 


Let  us  also  propose  that  with  the  aid  of  the  three  integrators 
of  angular  speed,  the  sensitivity  axes  of  which  are  parallel  to  axes 

x,  y,  z,  we  measure  the  increase  9„,  9„,  9  of  integrals  from  values 

xyz 

w  ,  to  ,  to  for  the  same  period  of  discretion: 
xyz 

*j 

9,  =  (  u,dt  (xyz).  (  7 ) 

Below,  we  examine  algorithms  for  computing  the  apparent  speed 

of  an  object  by  processing  signals  b  ,  b  ,  b  ,  9  ,  9  ,  9  with  the 

x  y  z  x  y  z 

aid  of  a  digital  computer. 

Let  us  first  examine  the  problem  of  finding  values  wv,  w  ,  w  . 

xyz 

Let  us  Introduce  matrix  0  with  the  aid  of  equation 
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Let  us  propose  that  matrix  ft  can  be  represented  by  the  Taylor 
series  in  the  area  of  the  beginning  of  the  step  t*t^: 


Q«Q*+Ql(/-/*)  +  -i-Qk  (<_/*)*+  ...  (9) 

('*<'<**  +  /»). 

then 

6~K>k  +  4rhKlk  +  -^h>Qi+  ...  (10) 

Let  us  write  vector  w  in  the  form  of  the  Taylor  series  in  the 
area  of  moment  in  time  t=t.  : 

tc-  =  Wk  +  Wk  (t  —  tk)  -  -y-  tt'k  ( t  —  lk )*  +  ■  ••  (  ll  ) 

(tk<t<tk+h). 

Using  equations  (9),  (10)  and  (11),  we  transform  expression  (6) 
to  the  form 

b  <m  Aw  +  Q  +  -j-  Awj  +  ~  b?  (Qkwk  —  *j*  0  (A‘).  ( 12 ) 

Here  Aw  -  increase  in  vector  w  at  step 

A »  —  hwk  +  -j-  +  •  •  •  (13) 

Equation  (12)  has  a  matrix  form  of  a  system  of  three  linear  algebraic 

equations  relative  to  values  Aw  ,  Aw  ,  Aw  .  The  solution  to  this  sys- 

a  y  z 

tern  of  equations  is  also  singular.  Considering  step  h  of  the  value  of 
the  first  order  of  smallness,  let  us  reject  (in  the  recalled  solution) 
members  up  to  the  third  order  of  smallness  inclusively: 

-  *>  +  (-  ©  +  4  ©2)  («.  +  -y  *)  -  T  e3~*  — IS  V  ( 14  } 


Dropping  into  the  expression  w^+1=w^+Aw  values  of  the  higher 
second  order  of  smallness,  we  acquire  an  algorithm  of  the  second 
order  for  determining  vector  w: 

U'*+i  —  a>„  +  b  +  0  +  -j- +  -y  bj  .  ( 15 ) 


In  the  scalar  form 


KWi  -  -y  b*  +  [  1  “  T  <0;  +  0*)]  +  T  +  (e*  +  T  e«6*)  x 

X  (»*»  +  T  ~  (®*  —  4* 0'0*)  (“’**  +  T  b')  (x‘^‘ 


SSiU 
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The  rejected  members  of  the  third  order  of  smallness  compose 
the  error  of  algorithm  (15)  at  step 

6kui  =»  -jy/i4  (3Qlwk  +  Qkwk  —  Qkwk).  (17) 

The  algorithm  of  ohe  first:  order  of  computation  of  the  apparent 
speed  can  be  acquired  by  rejecting  the  members  of  the  second  order 
which  enter  into  algorithm  (1 6) 

aix.*+i  «=  wxk  ■+■  bx  +  0,  +  -y  b» )  ~  (“*«*  +  T  b')  ' 1  ®  ^ 

The  error  of  this  algorithm  on  the  step  is  characterized  by  a 
matrix  expression 

Skw  —  — h*£lhi<k.  (19) 

Let  us  examine  algorithms  of  computation  of  values  IP;,  IP,,,  IP; 

For  finding  vector  W  we  can  use  relationship  (4)  after  some  number 
of  steps  of  computations  according  to  formula  (16)  or  (18).  Here, 
we  must,  with  the  proper  accuracy,  compute  matrix  L,  for  example  by 
means  of  integration  of  equation  (2).  Another  method  of  finding  W 
consists  of  using  relationship 

Wn+]  -  +  ZJU.AUV  (20) 

Here  ,  W  ...  -  values  of  W  at  moments  in  time  t„  and  t  ..  ; 
n  n+l  n  n+1 

Ln+1  -  value  of  matrix  L  at  the  moment  in  time  tn+1;  Awn  -  increase 
in  vector  w  in  the  length  of  time  (tn,  tn+1).  this  length  equals 
in  duration  several  steps  h  (on  the  order  of  5-10),  then  for  finding 
increase  in  Awn  we  can  use  algorithm  (18)  with  step  h  with  the  fol¬ 
lowing  conditions  at  moment  in  time  t  :  w„  =w  .  *w„  =0.  After  accom- 

n  xn  yn  zn 

plishing  transformation  according  to  formula  (20),  we  again  propose 
that  w*0  and  proceed  with  computations  according  to  formulas  (18) 
with  step  h  [2].  The  error  of  computing  w  at  the  step  with  the  same 
calculation  scheme,  as  we  can  see  from  formulas  (17)  and  (19)  is 
estimated  approximately  by  the  expression 

ika  —  -jy  h*  (tikwk  —  Qkwk).  (21) 

If  the  transformation  in  (20)  is  done  at  each  step  (tn+1*tn+h) 
and  value  h  is  sufficiently  small,  then  in  the  first  approximation 
Awn«b.  Hence,  we  acquire  the  algorithm  of  the  first  order 

W^>-Wk  +  (22) 
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In  estimating  the  error  of  this  algorithm,  we  can  propose  that 

b^w,  h.  The  error  v;hich  corresoonds  to  algorithm  (22)  of  finding  the 
«c 

vector  w  at  the  step,  as  we  can  see  from  a  comparison  with  formulas 
in  (18)  with  w^*Q,  is  determined  as 

bkw  ■»  -5-  hKlkwk.  (23) 

A  more  accurate  expression  for  the  increase  in  Aw^.  at  the  step 
can  be  acquired  by  proposing  in  formula  (14)  w=0: 

Awt -6- -j-  (e--Le»)  b  +  o  (A*).  (24) 

Examining  the  same  formulas  of  numerical  integration  of  equa¬ 
tion  (2),  we  can  be  sure  that  values  and  L^+1  of  matrix  L  at  the 
beginning  and  at  the  end  of  the  stec  satisfy  the  relationship 

L.l+1  a*  (Lt+\  T  Lit)  +  -j-(Lk+ 1  +  Lk)  0+0  (/!*)•  ( 25 ) 

Substituting  expressions  (24)  and  (25)  into  formula  (20)  and 
dropping  the  values  of  the  third  order  of  smallness,  we  acquire  the 
algorithm  of  the  second  order  of  computation  of  W: 

ri+1  -  Wk  +  4  <*•*+■  +  Ll)  fr.  (26) 

In  the  scalar  form,  this  algorithm  has  the  form 


-  Wi*  +  ~  l(U*+i  +  ^i*)  4,  +  (^..*+1  +  +  (  27  ) 

+  izi*)  4j)  (snO- 

The  error  of  algorithm  (26)  at  the  step  in  projections  to  the  axes 
of  the  trihedron  xys  is  determined  by  expression  (21). 

We  can  show  that  the  methodological  (accumulated)  error  of  <5W 
of  computing  W  with  sufficient  accuracy  is  approximated  by  formula 

I 

ar-  4-jVa^.  (28) 

0 

where  5  w  -  expression  for  the  error  of  computations  at  the  step  in 
which  the  current  values  of  kinematic  parameters  are  figured.  So, 
with  the  use  of  algorithm  (18) 


or 


*  - - 5-  h  J  L‘  W-jjdt. 


(29) 


With  the  use  of  the  same  algorithm  (22)  the  methodological  error  has 
the  form 

(30) 


Or  -  -1  It  \  LTQwdt. 
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Accomplishing  in  equation  (30)  integration  by  parts  and  using  the 
equation  in  (2),  we  acquire 


6ir  =  4*  hlf&e  - 


4-  h  \  LT9.x<dt  +4 -At  L'  Q'-x-dt. 


i 


31) 


With  considerable  angular  fluctuations  of  the  object,  the  last 
member  of  formula  (31)»  distinguished  only  by  sign  from  expression 
(29),  is  dominating,  since  it  has  the  tendency  to  grow  with  time. 
Thus,  the  accumulated  errors  of  algorithms  of  the  first  order  (18) 
and  (22)  are  close  in  value  and  opposite  in  sign. 

Algorithms  (26)  and  (18)  with  recalculation  according  to  the 
formula  in  (22)  and  with  a  return  to  null  of  the  initial  conditions 
provide  an  error 

I 

bW  -  ±  h*  J  Lt  (Q»  —  Qa>)  dt.  (32) 

.  0 

Finally,  an  estimate  of  the  error  of  algorithm  in  (15)  has  the  form 


^LT(ilw  —  Siw  +  3&w)dt.  (33) 

6 

The  selection  of  one  or  another  of  these  algorithms  is  deter¬ 
mined  by  the  characteristics  of  the  measured  elements  and  the  computer 
and  the  requirements  for  accuracy  in  determining  the  apparent  speed. 
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